#include <stdio.h>
#include "inv_mpu.h"

int main() {

    // 初始化MPU6050
    mpu_dmp_init();
    // 读取DMP数据
    float q[3];
    while (1) {
        if (mpu_dmp_get_data(&q[0], &q[1], &q[2]) == 0) {
            printf("pitch:\t%f\t\troll\t%f\t\tyaw\t%f\n", q[0], q[1], q[2]);
        }
        usleep(100000); // 100ms
    }

    return 0;
}